c = rand(3,1);
C = expm(hat(c));
T = eye(4);
T(1:3,1:3) = C;
T(1:3, 4) = [1 1 1 ]';

t = logm(T);
rho = t(1:3, 4);

J = jacobian_left(c);

J*rho
